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TURN  CONTROL  OF  SUBMERGED  VEHICLES 


I . INTRODUCTION 

The  equations  of  motion  of  underwater  vehicles  are  highly  nonlinear  [l)-[3] 
differential  equations,  derived  from  Newtonian  mechanics,  which  mathematically 
describe  the  hydrodynamic  and  flight  characteristic  of  submersibles.  It  has 
been  the  practice  of  engineers  to  use  these  equations  to  study  the  hydrodynamic 
forces  acting  on  the  vehicle,  with  the  aim  of  improving  its  design  and  handling 
characteristics.  In  the  critical  nonlinear  regions,  characterized  by  high  angle 
of  attack  and  side-slip  at  high  speed,  the  vehicle  motion  is  high  coupled 
(lateral  to  longitudinal)  and  is  very  difficult  to  analyze.  Significant  insight 
into  the  vehicle's  behavior  can  be  obtained  by  displaying  the  time  history  of  each 
hydrodynamic  term,  which  collectively  produce  the  total  force  and  moment  acting 
on  the  vehicle  from  instant  to  instant.  In  many  cases  of  interest,  for  a 
particular  maneuver  (e.g.,  depth  change,  or  turn),  only  a few  of  these  terms  tend 
to  dominate.  The  engineer  is  then  able  to  deeraphasize  the  remainder  of  the  terms 
so  that  he  can  concentrate  on  the  few  dominant  ones  with  which  he  can  more  easily 
deal.  In  this  report,  it  is  shown  how  these  time-history  displays  aid  the  analysis{4] 
of  a vehicle  which  possesses  adverse  depth  and  roll  transients  in  a maneuver,  say 
a hard  turn.  This  analysis  leads  to  a new  control  strategy  which  markedly  improves 
the  vehicle's  performance. 

An  empirical-experimental  study  of  the  turn  control  problem  is  also  presented 
which  confirms  the  effectiveness  of  the  new  turn  control  strategy.  A possible 
implementation  using  both  linear  and  nonlinear  (relay)  actuation  [5]  is  given.  Also 
included  is  a study  of  manual  strategies  used  in  the  past  where  the  pilot  had  to 
compromise  between  rapidity  of  the  turn  and  adverse  roll  and  depth. 
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II.  PILOTED  RUDDER  MANEUVERS 


In  evasive  underwater  maneuvers,  there  is  a need  for  performing  rapid 
turns  while  keeping  roll,  pitch,  and  depth  of  the  vehicle  as  stable  as 
possible.  In  an  attempt  to  imitate  the  rudder  maneuvers  initiated  by  a pilot 
wh^n  such  evasive  action  is  required,  3 different  rudder  commands  are  selected. 
These  are 

MAN-^t)"  3.5  * t 
MAN2(t)=  0.35  * t2 
MAN-j (t)=  0.035  * t3 

and  are  shown  in  Fig.  1,  2 and  3. 


Computer  runs  were  made  with  these  rudder  commands  for  two  cases: 

(a)  forward  speed  Uq  held  constant,  say,  by  means  of  a cruise  control  system, 
and  (b)  forward  speed  varying  in  the  absence  of  a cruise  control  system.  Also 
these  runs  are  made  both  in  the  presence  and  the  absence  of  LLCS,  i.e.,  linear 
longitudinal  control  system  (existing  in  the  NCSC  Trajectory  program).  For 
the  case  where  the  LLCS  is  a comparison  of  the  vehicle  response  between  the 
vehicle  response  with  and  without  cruise  control  is  given  in  Table  1. 

Table  1 

Vehicle  Responses  with  LLCS  Off 
la 


With  Cruise 

Control  (U  = 
o 

Const. ) 

Time  of 

Max 

Max 

Max 

180°  Turn 

Roll 

Pitch 

Depth 

(sec) 

(deg) 

(deg) 

(deg) 

MA-N^t) 

13.2 

-53.1 

-71.9 

415.6 

MAN2(t) 

14.8 

-58.7 

-69.0 

395.1 

MAN3(t) 

15.6 

-61.8 

-75.8 

385.8 

lb 

Without 

Cruise  Control 

Time  of 

Max 

Max 

Max 

180°  Turn 

Roll 

Pitch 

Depth 

(sec) 

(deg) 

(deg) 

(deg) 

MAN^t) 

16.6 

-28.9 

-25.3 

116.5 

MAN 2 (t) 

18.4 

-31.9 

-27.9 

116.9 

MAN  3 ( t ) 

19.8 

-36.6 

-25.7 

72.4 

: can  be  seen 

from  Table  1 

that  although 

the  180° 

turn  is  executed 

slightly  faster  when  the  speed  is  held  constant,  the  values  of  the 


r 
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maximum  roll,  pitch  and  depth  are  much  larger  than  for  the  case  where 
the  speed  is  not  held  constant.  In  particular,  the  maximum  is  nearly 
twice  as  much  as  for  the  case  where  cruise  control  is  not  utilized. 

We  believe  a slightly  slower  turning  time  with  greatly  enhanced 
response  stability  is  a good  tradeoff.  In  the  remaining  investigation, 
therefore,  we  will  cruise  contrbl  is  turned  off  during  rapid  turn 
maneuvers. 

Next  we  examine  the  performance  of  the  vehicle  for  these  pilot 
rudder  commands  in  the  presence  of  LLCS,  the  linear  longitudinal  control 
system  (existing  in  the  routine  AUTO  of  the  NCSC  trajectory  program). 

The  results  are  given  in  Table  2. 


Table  2 


Responses  of 

Vehicle 

to  Rudder 

Maneuvers 

When  Linear 

Control 

System  is 

Activated 

MAN. 

Time  of 

Max 

Max 

Max 

Final 

Final 

180°  Turn 

Roll 

Pitch 

Depth 

Roll 

Pitch 

(sec) 

(deg) 

(deg) 

(feet) 

(deg) 

(deg) 

16.8 

-29.3 

-21.4 

70.2 

-16.6 

-3.2 

MAN, 

18.6 

-32.3 

-24.6 

71.6 

-16.6 

-3.4 

‘*^3 

19.8 

-36.6 

-26.4 

72.4 

-16.6 

-3.5 

From  a comparison  of  Tables  2 and  lb  it  is  concluded  that 
the  existing  linear  longitudinal  control  system  does  not  adequately 
reduce  the  adverse  roll,  pitch  and  depth-change  during  a piloted 
turn.  This  points  to  the  need  for  better  coordinated  control 
during  rapid-turn  maneuvers.  In  Chapter  III  we  will  deal  with  this 
problem  extensively.  However,  let  us  point  out  that  among  the 
three  pilot  commands,  MAN^(t)  not  only  leads  to  a faster  turn-around 
time,  but  also  the  values  of  maxiumum  roll,  pitch  and  depth  change  are 
slighter  better  than  for  MA^Ct)  and  MAN^(t). 
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The  most  stable  and  fastest  turn  maneuver,  MAN^(t),  is  thus  seen  to  be 
the  best  suited  pilot  maneuver  for  evasive  operations.  For  this 
pilot  command,  the  rapidity  of  the  turn  can  be  increased  by  reducing  the 
duration  of  the  ramp,  but  of  course  at  the  expense  of  stability  of 
the  turn.  In  the  extreme  case,  this  command  becomes  the  same  as  the  step  comm- 
and (<$^=+35°)  for  which  the  180°  turn  can  be  performed  in  14.0  seconds. 

This  is  accompanied  by  a maximum  roll  of  -43.7°;  see  Table  3 for  the 
performance  under  a step  rudder  command  • 


Table  3 


Vehicle  Response  to  Hard  Rudder  (6r=+35  step) 
p constant;  LLCS  utilized 


Time 

Speed 

Pitch 

Depth 

Roll 

Heading 

(sec) 

(ft/sec) 

(deg) 

(feet) 

(deg) 

(deg) 

0 

8.7 

0 

0 

0 

0 

1 

8.2 

0.1 

0 

2.3 

-9.5 

2 

7.3 

0.1 

0 

10.7 

-27.0 

3 

6.5 

-2.6 

0.1 

-43.1 

-52.5 

3.8 

6.0 

-7.3 

0.5 

-43.7 

-55.2 

4 

5.9 

-8.8 

0.6 

-43.4 

-57.8 

5 

5.5 

-15.9 

2.2 

-34.2 

-70.5 

6 

5.2 

-21.0 

4.7 

-21.7 

-84.0 

7 

5.0 

-22.8 

7.9 

-16.3 

-98.0 

8 

4.8 

-22.4 

11.4 

-18.2 

-111.4 

9 

4.7 

-21.4 

14.8 

-17.8 

-124.0 

10 

4.7 

-20.7 

18.1 

-15.7 

-136.2 

13.6 

4.5 

-18.1 

28.7 

-16.1 

-179.6 

20 

4.4 

-15.1 

43.8 

-16.4 

-256.1 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

• 

40 

4.3 

-7.9 

72.4 

-15.6 

-488.1 

III.  EFFECT  OF  K AND  K._  TERMS  IN  HARD  TURN 
v 4T 


The  vehicle  considered  (henceforth  called  USFRPV)  is  neutrally  buoyant  and 
equipped  with  three  control  surfaces,  bow  planes, stern  planes  and  rudder  with 
maximum  deflections  of  20°,  25°  and  35°,  respectively.  Table  4 shows  the  time 
history  for  a maximum  turn-rate  maneuver  where  the  bow  and  stern  planes  are 
undefiected  and  the  rudder  is  at  the  maximum  deflection  of  35°.  The  run  is  made  ty 
setting  XD(1)  = 0 in  the  program  and  the  speed  is  set  at  8,66  ft/s.  Qne  notes  the 

Table  4 

Turn  Time  Histories:  Stern  and  Bow  Plane  at  Zero 
Deflection,  Rudder  at  35  degrees. 


Tice 

(sec) 

W (ft/sec) 

V (ft/sec) 

Depth  (ft) 

Pitch  Rate 
q (Deg/Sec) 

Pitch  Angle 

0 (Deg) 

Roll  Angle 
$ (Deg) 

Yaw  Angle 
(Deg) 

0.0 

0.0 

0.0 

50.00 

0.0 

0.0 

0.0 

0.0 

0.5 

-0.05 

0.84 

50.00 

-10.36 

-0.02 

1.90 

-2.84 

1.0 

-0.07 

1.62 

49.99 

-15.73 

0.05 

2.30 

-9.50 

1.5 

0.09 

2.16 

49.98 

-17.81 

0.19 

-1.78 

-18.02 

2.0 

0.46 

2.42 

49.97 

-17.83 

0.07 

-10.68 

-27.04 

2.5 

C .94 

2.42 

49.98 

-16.63 

-0.76 

-23.22 

-35.82 

3.0 

1.29 

2.24 

50.05 

-15.19 

-2.60 

-35.36 

-43.89 

3.5 

1.33 

2.09 

50.25 

-14.40 

-5.43 

-92.44 

-51.11 

4.0 

1.25 

2.04 

50.64 

-14.23 

-8.95 

-43.36 

-57.66 

4.5 

1.02 

2.04 

51.28 

-14.20 

-12.78 

-39.80 

-63.69 

5.0 

0.  SI 

2.04 

52.20 

-14.05 

-16.46 

-33.63 

-70.17 

6.0 

0.57 

2.00 

54.82 

-13.51 

-21.88 

-19.61 

-83.63 

7.0 

0.73 

1.83 

58.15 

-12.58 

-23.78 

-13.35 

-97.80 

8.0 

1.07 

1.65 

61.75 

-11.10 

-23.29 

-17.21 

-111.32 

9.0 

1.14 

1.50 

65.33 

-10.52 

-22.61 

-18.44 

-123.83 

10.0 

1.04 

1.49 

68.82 

-10.83 

-22.25 

-15.84 

-136.03 

11.0 

1.02 

1.48 

72.26 

-10.85 

-22.09 

-15.66 

-148.26 

12.0 

1.02 

1.45 

75.65 

-10.74 

-21.86 

-16.33 

-160.43 

13.0 

0.99 

1.46 

78.99 

-10.83 

-21.72 

-16.09 

-172.55 

14.0 

0.95 

1.47 

82.28 

-10.90 

-21.72 

-15.99 

175.28 

15.0 

0.96 

1.47 

85.56 

-10.89 

-21.79 

-16.33 

163.09 

16.0 

0.99 

1.48 

88.83 

-10.91 

-21.90 

-16.40 

150.88 

17.0 

0.93 

1.48 

92.10 

-10.92 

-22.66 

-16.33 

138.66 

18.0 

0.93 

1.48 

95.38 

-10.92 

-22.21 

-16.35 

126.43 

19.0 

0.93 

1.48 

98.68 

-10.90 

-22.35 

-16.36 

114.19 
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undesirable  depth  loss  and  large  roll  excursion.  The  problem  is  to  find  the 
hydrodynamic  cause  and  then  design  a control  strategy  for  the  bow,  stern  and 
rudder  planes  to  counter  the  depth  and  roll  variations  — while  still  maintaining 
the  high  turn-rate.  The  first  concern  is  the  depth  loss.  Looking  at  a time 

(history  of  the  toal  body-axis  Z force  and  the  toal  pitch  moment  (right  hand  side 
of  equations  of  motion),  shown  in  Fig.  4,  we  see  that  depth  loss  does  not  come 
from  the  Z force  (which  is  negative,  indicating  an  upward  force),  but  rather  is 
due  to  a negative  pitching  moment  which  causes  a delayed  downward  pitch  angle. 

I 


Fig.  A.  Z-Force  and  Pitch  Moment:  Turn  Maneuver  with  Zero 

Deflection  of  Stern  and  Bow  Planes,  Rudder  at  35  Degrees. 
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The  time  histories  in  Fig. 5 are  a breakdown  of  the  dominant  terms  which  cause 
this  negative  pitching  moment.  The  obvious  fix  is  to  use  the  stern  planes  to 
counter  the  negative  moment,  the  bow  planes  to  produce  an  upward  force  when  the 
vehicle  is  pitched  down.  In  general,  the  bow  planes  on  this  particular  vehicle 
are  marginally  effective  and  produce  only  moderate  Z force  and  pitch  moment. 


500 


Mq  moment 


7ig.  5. 


Dominate  Negative  Pitch  Moment  Terms:  Turn  Maneuver 
with  Zero  Deflection  of  Stern  and  Bo«-  ^lanes,  Pudder 
at  35  Degrees. 


Table  5 shows  the  turn  maneuver  with  bow  planes  in  maximum  rise  position  6^  = 20°, 
and  stern  plane,  6g,  held  at  10°.  This  combination  reduces  the  depth  excursion 
to  an  acceptable  level.  However,  the  adverse  roll  motion  is  still  present.  The 
solution  to  this  problem  is  not  obvious.  The  negative  roll  excursion  results 
from  the  negative  roll  moment  produced  during  0.5  and  2.0  second  time  interval 
(Fig.  6). 


Table  5 


Turn  time  histories:  Stern  planes  at  -10  degrees. 
Bow  planes  at  20  degrees  and  rudder  at  15  degrees. 


Time 

(sec) 

W (ft/sec) 

V (ft/sec) 

Depth  (ft) 

Pitch  Rate 
q (Deg/Sec) 

Pitch  Angle 

0 (Deg) 

Roll  Angle 
$ (Deg) 

Yaw  Angle 
(Deg) 

0.0 

0.0 

0.0 

50.00 

0.0 

0.0 

0.0 

0.0 

0.5 

-0.10 

0.83 

49.92 

2.61 

0.82 

1.66 

-2.81 

1.0 

-0.07 

1.62 

49.70 

3.97 

2.61 

0.05 

-9.38 

1.5 

0.21 

2.14 

49.25 

5.85 

4.50 

-8.61 

-17.71 

2.0 

0.68 

2.32 

48.61 

7.73 

5.62 

-22.75 

-26.60 

2.5 

1.07 

2.24 

47.87 

8.31 

5.34 

-36.77 

-35.27 

3.0 

1.17 

2.13 

47.15 

7.48 

3.60 

-45.13 

-43.28 

3.5 

1.06 

2. OS 

46.57 

6.04 

0.83 

-46.99 

-50.59 

4.0 

0.87 

2.06 

46.23 

4.75 

-2.40 

-44.37 

-57.44 

4.5 

0.63 

2.04 

46.15 

3.88 

-5.54 

-39.09 

-64.16 

5.0 

0.53 

2. CO 

46.32 

3.45 

-8.16 

-32.44 

-70.93 

6.0 

0.41 

1.91 

47.28 

3.69 

-10.97 

-20.36 

-84.75 

7.0 

0.60 

1.73 

48.68 

5.07 

-10.6" 

-16.89 

-98.24 

8.0 

0.81 

1.60 

50.13 

5.89 

-8.76 

-18.65 

-110.82 

9.0 

C.S2 

1.52 

51.41 

5.41 

-6.62 

-17.25 

-122.63 

10.0 

C.7S 

1.49 

52.46 

4.96 

-2.63 

-15.65 

-134.26 

11.0 

0.30 

1.45 

53.28 

4.98 

-2.70 

-16.10 

-145.67 

12.  C 

0.73 

1.44 

53.86 

4.83 

-0.85 

-16.22 

-156.97 

13.0 

0.79 

.1.45 

54.20 

4.57 

0.77 

-16.01 

-168.26 

14.0 

0.72 

1.45 

54.31 

4.47 

2.18 

-16.47 

-179.60 

15.0 

0.70 

1.46 

54.22 

4.38 

3.39 

-16.92 

169.03 

16.0 

0.67 

1.47 

53.97 

4.23 

4.41 

-17.02 

157.62 

17.0 

0.65 

1.43 

53.56 

4.13 

.5.27 

-17.14 

146.16 

18.0 

0.63 

1.49 

53.04 

4.09 

6.02 

-17.53 

134.66 

19.0 

0.62 

1.49 

52.40 

4.03 

6.69 

-17.41 

123.13 

10 
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Fig.  7 shows  the  two  dominant  terms  which  contribute  to  this  negative 
moment.  These  terms  are 


K uv 
v 


and 


AT 


2 2 2J  -1  A2+Vt 

(u  +wt  +vt  At  an  [ 


2 2 

4v  w (w  -v  ) 

2 2 
(wt  +vt  ) 


where 


u = axial  velocity 
v = side-slip  velocity 
w = plunge  velocity 
q = pitch  rate 
r = yaw  rate 

vtail  = distance  from  center  of  mass  to  tail  (negative  value) 


and 


Wt  = w " q Xtail 

v = v + r x . . 
t tail 

K is  a hydrodynamic  coefficient  less  than  zero 

is  a hydrodynamic  coefficient  greater  than  zero 

Because  the  turn  is  to  the  left  (yaw  rate  negative) , v will  be  generally 
negative.  One  could  reduce  the  effect  of  the  Kv  term  by  reducing  the  rudder 
deflection,  thereby  reducing  v.  But  this  is  undesirable  since  it  would  lead 
to  a concurrent  reduction  in  turn  rate.  However,  the  second  term  offers  an 
alternative  solution.  In  the  turn  (Table  5)  one  observes  that 


wfc  > 0 


v > 0 


2 . 2 

Vt  > Wt 


12 


It  is  possible  to  reverse  the  first  relation  while  maintaining  the  second  and 
third  which  would  create  a positive  roll  moment  with  the  term.  Clearly,  a 

negative  wt  exists  if  the  vehicle  is  pitched  down  to  fLy  at  a negative  angle  of 
attack.  This  can  be  obtained  by  deflecting  the  stern  plane  to  a dive  position. 
Because  there  is  a larger  time  lag  between  the  stern  plane  deflection  and  depth 
response  than  between  the  stern  plane  deflection  and  pitch  response,  there  will 
be  an  appreciable  length  of  time, right  after  the  planes  are  deflected, where  the 
vehicle  is  pitched  down  undergoing  little  depth  change,  and  thus  producing  the 
desired  negative  w^.  If  this  interval  encompasses  the  adverse  roll  region,  then 
it  would  be  possible  to  use  this  control  strategy  to  alleviate  the  large  roll 
excursions.  The  stern  plane  must  soon  be  sent  to  a rise  position  so  that 
significant  depth  change  does  not  accrue  from  the  dive  position.  After  several 
simulation  studies,  involving  different  magnitudes  and  transition  rates,  an 
acceptable  stern  plane  strategy  was  devised.  Table  6 shows  the  time  histories 
of  the  vehicle's  response.  Fig.  8 shows  the  total  roll  moment  time  history  for 
this  maneuver  and  Fig.  9 shows  the  roll  moment  produced  by  the  and  terms. 


Table  6.  New  turn  time  histories:  Bow  planes  at  20  degrees 
and  rudder  at  35  degrees. 


Time 

S V Depth  Pitch  Rate, 

Pitch 

Roll  Angle, 

Yaw  Angle,  S.  Pin. 

(sec) 

(ft/sec)  (ft/sec)  (ft)  q 

e 

$ 

* 

Def 1 . , 6s 

(deg/sec) 

(deg) 

(deg) 

(deg) 

(deg) 

0.0 

0.0 

0.0 

50.00 

0.00 

0.00 

0.00 

0.00 

0.00 

0.5 

-0.35 

0.83 

49.91 

-0.32 

0.11 

1.92 

-2.82 

10.42 

1.0 

-0.76 

1.56 

49.67 

-2.45 

-0.23 

3.44 

-9.45 

20.83 

1.5 

-1.12 

2.03 

49 . 34 

-4.32 

-1.42 

4.40 

-17.83 

25.00 

2.0 

-1.33 

2.25 

49.05 

-4.80 

-2.93 

6.23 

-26.73 

25.00 

2.5 

-1.40 

2.32 

48.87 

-4.52 

-4.16 

8.60 

-35.54 

25.00 

3.0 

-1.34 

2.34 

48.79 

-3.80 

-4.85 

10.49 

-44.03 

25.00 

3.5 

-1.21 

2.34 

48.80 

-2.94 

-5.01 

11.16 

-52.11 

25.00 

4.0 

-1.01 

2.33 

48.86 

-2.11 

-4.83 

10.24 

-59.75 

25.00 

4.5 

-0.78 

2.31 

48.95 

-1.31 

-4.54 

7.66 

-67.00 

23.60 

5.0 

-0.54 

2.27 

49.05 

-0.55 

-4.31 

3.61 

-73.90 

22.20 

6.0 

-0.09 

2.13 

49.29 

0.59 

-4.55 

-6.67 

-86.79 

19.40 

7.0 

0.12 

1.95 

49.62 

0.84 

-6.00 

-13.81 

-98.77 

16.60 

8.0 

0.06 

1.82 

50.16 

0.33 

-8.21 

-12.83 

-110.28 

13.80 

9.0 

-0.06 

1.75 

50.99 

0.10 

-10.07 

-6.99 

-121.83 

11.00 

10.0 

-0.01 

1.72 

52.07 

0.97 

-10.66 

-4.30 

-133.54 

8.20 

11.0 

0.25 

1.69 

53.28 

2.53 

-10.12 

-8.98 

-145.14 

5.40 

12.0 

0.47 

1.61 

54.47 

3.45 

-9.47 

-16.04 

-156.49 

2.60 

13.0 

0.49 

1.56 

55.61 

3.23 

-9.38 

-17.78 

-167.71 

-0.20 

14.0 

0.43 

1.56 

56.78 

2.96 

-9.58 

-15.58 

-179.07 

-3.00 

15.0 

0.45 

1.56 

57.94 

3.30 

-9.39 

-14.58 

169.40 

-3.00 

16.0 

0.52 

1.54 

59.13 

3.77 

-8.76 

-15.62 

157.88 

-3.00 

17.0 

0.55 

1.52 

60.25 

3.84 

-8.03 

-16.34 

146.44 

-3.00 

18.0 

0.54 

1.52 

61.31 

3.66 

-7.42 

-16.09 

135.03 

-3.00 

19.0 

0.53 

1.52 

62.29 

3.59 

-6.90 

-15.89 

123.61 

-3.00 

Moment 


2 4 6 8 10  12  14  16  18  2C 

time (sec) 

Fig.  8.  Total  Roll  Moment:  New  Turn  Maneuver  as 
Described  in  Table  6. 


Moment 
(f t-lbs) 


Fig.  9.  K and  K.^,  Roll  Moment  Terms:  New  Turn  Maneuver 
v 4T 

as  described  in  Table  6. 


IV.  COORDINATED  TURN  CONTROL  SYSTEM 


This  section  presents  an  empirical-experimental  study  of  the  coordinated  rapid 
turn  problem.  Basically,  the  application  of  hard-rudder,  (maximum  amplitude 
step)  or  a slight  modification  thereof,  will  accomplish  this  goal.  This, 
however,  predictably  results  in  severe  excursions  of  roll  and  pitch,  and  loss 
of  depth.  It  is  therefore  necessary  to  coordinate  the  bow-plane  and  stern- 
plane  actions  with  the  rudder  so  as  to  eliminate  or  minimize  these  ill-effects. 

In  this  section,  a control  strategy,  and  later  a feedback  system,  will  be 
developed  experimentally  to  achieve  a coordinated  rapid  turn.  The  system  will 
be  called  'TURN  CONTROL  SYSTEM'. 

6^  = 35°:  Open-Loop 

The  development  of  roll  control  is  given  in  two  phases.  In  the  first 

phase,  we  seek  an  open  loop  strategy  to  decrease  the  roll,  depth  change, 

and  pitch.  In  the  second  phase  (page  25  ) we  will  implement  the  ideas  of  the 
open  loop  strategy  into  a feedback  mode.  Since  the  vehicle  is  slightly 
asymmetric,  i.e.,  responses  to  positive  and  negative  rudder  are  not  identical, 

(see  Table  7)  the  control  strategy  is  to  be  found  for  these  separately. 

TABLE  7 


Demonstration  of  Need  for  Separate  Analysis  for 
positive  and  Negative  Rudder  Trajectories. 


5r 

Final 

Final 

Maximum 

Final 

Pitch 

Roll 

Roll 

Depth  (ft) 

+35° 

-23° 

-16° 

-44° 

119 

-35° 

-30° 

18° 

O 

oc 

>3“ 

149 

Experiments  were  performed,  initially,  to  determine  the  effect  of 
different  bow  and  stern  plane  step-inputs  upon  vehicle  response.  A summary  of 
some  of  the  runs  is  given  in  Tables  8 and  9 . 


TABLE  8 

5r  = +35°  (40  second  runs) 

EFFECT  OF  BOW-PLANE  (fi  = 0) 

s 


fib 

Final 

Pitch (deg) 

Final 

Roll (deg) 

Maximum 
Roll (deg) 

Final 
Depth(f t) 

+10° 

-16 

-16 

-45 

83 

-10“ 

-30 

-16 

-42 

147 

+20” 

- 7 

-15 

-44 

39 

O 

O 

CN 

1 

-34 

-75 

-39 

164 

15 

EFFECT 

OF  STERN-PLANE  (6,  = 0) 
b 

6 

s 

Final 

Pitch  (deg) 

Final 

Roll  (deg) 

Maximum 

Roll  (deg) 

Final 
Depth  (ft) 

-5 

-9 

-16 

-45 

78 

+10 

-50 

-17 

-34 

169 

-10 

4 

-17 

-45 

31 

+25 

-67 

- 9 

-19 

86 

-25 

32 

-22 

-37 

-86 

TABLE  9 

6r  = 

-35°  (40  second  runs) 

EFFECT  OF  BOW-PLANE  (6  =0) 

s 

5b 

Final 

Pitch  (deg) 

F inal 

Roll  (deg) 

Maximum 

Roll  (deg) 

Final 
Depth  (ft) 

+10 

-22 

18 

49 

111 

-10 

-37 

17 

47 

175 

+20 

-16 

17 

49 

66 

-20 

-42 

16 

44 

190 

EFFECT 

OF  STERN  PLANE  (6L  = 0) 
b 

w s 

Final 

Pitch  (deg) 

Final 

Roll  (deg ) 

Maximum 

Roll  (deg) 

Final 

Depth  (_f t ) 

-5 

-14 

18 

50 

104 

+1C 

-60 

19 

36 

201 

-10 

0 

18 

49 

54 

+25 

-71 

10 

22 

208 

-25 

31 

23 

41 

-83 

From  the  above  tables,  it  is  seen  that: 

1.  A large  positive  initial  stern  plane  deflection  can  reduce  or  even 
eliminate  the  roll. 

2.  A small  negative  stern  plane  deflection  can  be  used  to  control  the 
steady-state  pitch. 

3.  A positive  bow  deflection  of  +20°  would  help  reduce  undesirable  change 
in  depth. 

Using  the  data  in  Tables  8 and  9,  and  after  much  experimentation,  the  bow 
and  stern  plane  inputs  in  Fig.  10a  and  10b  were  determined. 
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TABLE  10a 

6 = +35°  (Our  Strategy) 

Ur  = 8.66  ft/s 
o 


TIME 

SPEED 

PITCH 

DEPTH 

ROLL 

HEADING 

(sec) 

(ft/sec) 

(deg) 

(ft) 

(deg) 

(deg) 

0 

8.7 

0 

0 

0 

0 

1 

8.0 

-0.2 

-3.3 

3.5 

-9.4 

2 

7.0 

-2.7 

-0.9 

5.7 

-26.7 

3 

6.1 

-4.7 

-1.2 

9.9 

-44.0 

4 

5.4 

-4.8 

-1.2 

10.1 

-59.8 

5 

5.0 

-4.3 

-1.0 

4.0 

-73.9 

6 

4.7 

-4.5 

-0.8 

-6.0 

-86.9 

7 

4.5 

-5.9 

-0.4 

-13.2 

-98.9 

8 

4.4 

-8.1 

0.1 

-12.7 

-110.4 

9 

4.3 

-9.9 

0.9 

- 7.2 

-121.9 

10 

4.3 

-10.6 

1.9 

- 4.4 

-133.6 

11 

4.3 

10.1 

3.1 

- 8.6 

-145.2 

12 

4.3 

-9.5 

4.3 

-15.6 

-156.6 

12.8 

4.3 

-9.4 

5.2 

-17.8 

-165.6 

13 

4.3 

-9.4 

5.5 

-17.7 

-167.8 

14 

4.3 

-9.6 

6.6 

-15.7 

-179.2 

15 

4.3 

-9.4 

7.8 

-14.6 

-190.7 

20 

4.3 

-6.4 

13.1 

-16.0 

-247.9 

40 

4.3 

-1.1 

22.1 

-16.0 

-476.6 

18 
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TABLE  10b 


TIME 

SPEED 

6 = 
r 

PITCH 

(sec) 

(ft/sec) 

(deg) 

0 

8.7 

0 

1 

8.0 

-0.4 

2 

7.0 

-3.9 

3 

6.1 

-7.7 

4 

5.4 

-9.0 

5 

5.0 

-8.8 

6 

4.7 

-8.7 

7 

4.5 

-9.8 

8 

4.4 

-12.0 

9 

4.3 

-14.4 

10 

4.3 

-15.8 

10.4 

4.3 

-15.9 

11 

4.3 

-15.6 

12 

4.3 

-14.7 

13 

4.3 

-14.2 

14 

4.3 

-14.0 

15 

4.3 

-13.5 

20 

4.3 

- 8.9 

40 

4.3 

-0.9 

(Our  Strategy) 


DEPTH 

ROLL 

HEADING 

(ft) 

(deg) 

(deg) 

0 

0 

0 

-0.3 

-0.1 

9.4 

-0.9 

0.8 

26.5 

-1.0 

-4.6 

43.5 

1 

o 

Ln 

-8.3 

59.3 

0.2 

-4.8 

73.7 

1.0 

5.7 

86.7 

1.9 

16.6 

98.8 

2.9 

19.0 

110.2 

4.3 

13.1 

121.7 

5.9 

7.6 

133.5 

6.6 

7.3 

138.3 

7.7 

9.6 

145.4 

9.6 

16.8 

157.0 

11.4 

19.8 

168.5 

13.2 

17.9 

180 . Q 

14.9 

16.9 

191.7 

22.6 

17.6 

249.4 

34.1 

17.9 

478.1 
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Table  11.  Comparison  of  Control  Strategies 


TABLE  a 

6 = +35=’ 

r 

Max  Pitch, 
Time 

Max  Roll, 

Time 

Max  Depth, 
Time 

Heading 
180°  Time 

No  Control 

-23.6, 

7.2 

-43.7, 

3.8 

119.0,  40 

13.6 

V20’ 

6 = +25 
s 

-42.6, 

40 

-13.1, 

37.6 

100.8,  40 

14 

V20* 

6 = -25 

s 

33.4, 

30.8 

-39.6, 

3.4 

-115.8,  40 

13.6 

USF 

-10.6, 

10 

-17.8, 

12.8 

22.1,  40 

14 

TABLE  b 

6 = -35° 

r 

Max  Pitch, 
Time 

Max  Roll, 
Time 

Max  Depth, 
Time 

Heading 

180°Time 

> 

No  Control 

-30.4,  7.4 

48.5,  3.8 

148.1,  40 

13.4 

V20’  v *:3 

-53.5,  40 

18.2,  38.2 

128.1,  40 

14 

V20>  V -:5 

31.6,  26.2 

43.3,  3.2 

-105.3,  40 

13.8 

USF 

-15.9,  10.4 

17.9,  14 

34.1,  40 

14 

r 


1.  No  control  system  (l.e.t  6 =>  0,  5.  = 0) 

s b 

2.  6 = 25°,  6,  = 20°  steps 

s 0 

3.  = -25°,  6^  = 20°  steps 

All  of  these  simple  strategies  are  inferior  or  totally  unacceptable  compared 
to  ours. 


The  roll  response  of  our  control  strategy  is  compared  to  the  roll  responses 
of  the  above  strategies  in  Fig. (Note:  Although  the  roll  for  the  simple 
strategy  2 may  look  acceptable,  the  corresponding  depth  response  is  disasterously 
bad  — the  vehicle  dives  continually.) 


Fig. 11.  Comparison  of  Roll  Responses 
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6r  = 20  : Open- Loop 

To  test  the  versatility  of  our  strategy,  (large  positive  stern  plane 
deflection  of  short  duration  followed  by  a small  negative  stern  plane  deflection 
together  with  a constant  positive  bow  plane  deflection  for  the  duration  of  the 
run)  we  next  examine  the  case  of  a +20°  hard  rudder.  The  stern  and  bow  plane 
inputs  devised  for  this  case  are  shown  in  Fig. 12. 


Deflection 

(deg) 


Bow  Deflection 
Stern  Deflection 


i j 


Fig.  12a.  Control  Strategy  F0r  <5^  = +20° 


Deflection 

(deg) 


Bow  Deflection 
Stern  Deflection 


Fig.  12b.  Control  Strategy  For  6 = -20° 


The  responses  to  these  trajectories  are  listed  in  Tables  12a  and  12b. 


TABLE  12a 


6 = +20° 
r 

(Our 

Strategy) 

Time 

Speed 

Pitch 

Depth 

Roll 

Heading 

(sec) 

(ft/sec) 

(deg) 

(ft) 

(deg) 

(deg) 

0 

8.7 

0.0 

0.0 

0.0 

0.0 

1 

8.3 

-0.4 

-0.3 

2.5 

-5.7 

2 

7.8 

-4.2 

-0.9 

1.6 

-17.1 

3 

7.1 

-9. 1 

-1.1 

0.5 

-29.9 

4 

6.5 

-12.5 

-0.5 

1.7 

-42.6 

5 

6.1 

-14.0 

0.8 

2.7 

-55.0 

5.4 

6.0 

-14.1 

1.39 

2.17 

-59.9 

6 

5.8 

-14.0 

2.4 

-0.4 

-66.9 

7 

5.7 

-13.5 

4.1 

-8.0 

-78.2 

8 

5.5 

-13.2 

5.8 

-16.0 

-88.9 

9 

5 . 5 

-13.4 

7.6 

-18.6 

-99.2 

10 

5.4 

-13.3 

9.4 

-16.7 

109.5 

11 

5.4 

-12.5 

11.3 

-14.9 

-119.8 

12 

5.4 

-11.0 

13.0 

-14.7 

-129.9 

13 

5.4 

-9.3 

14.6 

-14.9 

-139.8 

14 

5 . 4 

-7.7 

16.0 

-14.8 

-149.5 

15 

5.4 

-6.3 

17. 1 

-14.8 

-159.3 

16 

5.4 

-4.9 

18.0 

-14.8 

-169.0 

17 

5 . 4 

-3.7 

18.6 

-14.9 

-178.8 

17.2 

5.4 

-3.5 

18.7 

-14.9 

-180.7 

20.0 

5.4 

-0.6 

19.4 

-15.2 

-206.2 

20.2 

5.4 

-0.4 

19.4 

-15.2 

-208.2 

40.0 

1 

5.4 

10.6 

23 

-2.6 

-15.7 

-408.4 

i 

v- 

k ; d 


TABLE  12  b 


6^  = -20  (Our  Strategy) 


Time 

(sec) 

Speed 
(f  t/sec) 

Pitch 

(deg) 

Depth 

(ft) 

Roll 

(deg) 

Heading 

(deg) 

0.0 

8.7 

0.0 

0.0 

0.0 

0.0 

1.0 

8.3 

-0.5 

-0.3 

0.9 

5.6 

2.0 

7.8 

-5.0 

-1.0 

4.3 

16.8 

3.0 

7.1 

-11.1 

-0.9 

4.9 

29.0 

4.0 

6.5 

-15.6 

0.1 

1.9 

41.5 

5.0 

6.1 

-17.6 

1.8 

-0.5 

54.1 

5.6 

6.0 

-17.8 

3.1 

0.5 

61.4 

6.0 

5.9 

-17.8 

4.0 

2.6 

66.2 

7.0 

5.7 

-17.3 

6.3 

11.7 

77.6 

8.0 

5.5 

-17.2 

8.6 

20.9 

88.4 

8.8 

5.5 

-17.5 

10.5 

23.1 

96.8 

9.0 

5.5 

-17.6 

11.0 

22.9 

98.9 

10.0 

5.4 

-17.8 

13.0 

20.5 

107.3 

11.0 

5.4 

-16.9 

16.1 

17.5 

120.0 

12.0 

5. 4 

-15.2 

18.6 

17.0 

130.3 

13.0 

5.4 

-13.3 

20.9 

16.  8 

140.3 

14.0 

5. 4 

-11.  3 

22.9 

16.6 

150.2 

15.0 

5 . 4 

- 9.5 

24.6 

16.6 

159.9 

16.  C 

5 . 4 

- 7.8 

26.0 

16.8 

169.7 

17.0 

5.4 

- 6.3 

27.2 

17.0 

179.4 

20.0 

5.4 

- 2.5 

29.2 

17.6 

208.8 

40.0 

5.4 

-10. 1 

11.1 

18.7 

408.6 
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As  observed  in  the  preceding  discussion,  the  inclusion  of  a large  positive 

stern  plane  deflection  at  the  beginning  of  a hard  rudder  maneuver,  effectively 

reduces  or  eliminates  the  snap  roll,  (for  +35°  rudder,  snap  roll  was  reduced 

from  -43.7°  to  -17.8°  when  compared  to  uncoordinated  hard  rudder).  After  the 

(initial)  large  positive  stern  plane  deflection,  and  its  gradual  relaxation  to 

zero,  a small  negative  value  is  required  for  the  duration  of  the  maneuver  to  control 

and  maintain  depth  (for  the  +35°  rudder  case,  the  depth  change,  119.0  ft  with  no 

coordinated  control,  was  reduced  to  22.1  ft.  by  our  strategy). 

Also  consider  the  case  of  +20°  hard  rudder.  Our  control  strategy  for 

this  case  results  in  a max  roll  of  -18.6°  and  a maximum  depth  deviation  of 

-8.5  feet.  The  corresponding  values  for  the  uncontrolled  case,  i.e.  when  the 

+20°  is  not  accompanied  by  stern  and  bow  deflections,  are  -32°  and  67  ft. 

This  improvement  is  quite  significant.  It  may  also  be  noted  that  a 180°  turn 

is  achieved  for  the  two  cases  (+35°5  , + 20°5  ) in  14  second  and  17.2  second, 

r r 

respectively . 

C losed  Loop 

After  the  completion  of  phase  1,  with  control  strategies  determined  for 
+35°  rudder  manuever,  the  actuation  of  bow  and  stern  plane  inputs  is  examined 
in  a feedback  configuration.  This  incorporation  of  the  control  strategy  into 
a closed  loop  in  the  subroutine  AUTO  constitutes  phase  two  of  roll  control 
development . 

The  proposed  feedback  system  consists  of  two  subsystems: 

Yaw-rate  Actuated  Subsystem:  This  consists  of  two  positive  relays, 
both  actuated  bv  the  vehicle  yaw-rate.  They  generate  (i)  a component  6 

Br 

for  the  stern  plane,  and  (ii)  a component  6^,  for  the  bow  plane.  REI.^ 
furnishes  the  short  duration  +25°  stern  plane  deflection  at  the  beginning 
of  the  ir.anuever,  and  REL,  a constant  +20°  bow  plane  deflection  for  the 
entire  duration  of  the  rapid  turn  manuever. 

Linear  Subsystem:  This  consists  of  the  longitudinal  control  system 
previously  existing  in  the  NCSL  trajectory  program  augmented  by  the  output 
of  a leaky  integrator,  excited  by  depth  error,  to  the  stern  plane  (see 
Fig.  13).  The  intent  of  the  augmentation  is  to  control  vehicle  depth  during 
rapid-turn  as  well  as  to  fine-tune  it  (back  to  the  ordered  value)  in  the 
steady-state . 

25 


i 


ip  Actuated  Subsystem 

The  heading  rate  is  the  sampled  quantity  because  the  roll  is  intimately 

related  with  large  heading  rate.  We  will  use  this  signal  to  actuate  the  stern 

and  bow  planes  in  order  to  control  the  roll.  In  particular,  the  components 

6^  and  6^  are  produced  by  positive  relays  shown  in  Fig. 14. 
r r 

6 (stern-plane  deflection) 

S3 


I ! 


-1.75 


I 


i 

i 

i 

T 

l 

i 


(bow-plane  deflection) 


1.75 

yaw  rate 


(b)  Relay  for  Bow  Plane  Input  (5 

3 

Fig. 14.  Positive  relays  for  generating 

component  3 to  stern  and  bow-plane  inputs. 
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The  input  to  the  bow  plane  relay  is  the  heading  rate  itself  because  a large 
positive  bow  deflection  is  required  throughout  the  duration  of  the  rapid  turn. 
The  input  to  the  stern  plane  relay,  however,  is  a signal  produced  by  the  washout 
filter  (Fig.  15  ) which  produces  a transient  pulse  just  long  enough  to  actuate 
the  relay  for  a few  seconds  at  the  beginning  of  the  turning  maneuver.  It  should 
also  be  noted  that  the  relay  is  enabled  for  a duration  dependent  upon  the 
severity  of  the  turning  rate.  That  is,  the  higher  the  turning  rate,  the  longer 
the  deviation  for  which  the  relay  yields  a +25°  stern  plane  signal. 

The  design  of  the  filter  is  discussed  briefly.  For  +35°  rudder  input  the 
heading  rate  is  shown  in  Fig.  16. 


A(0.  15c.-0.05) 

. -0.15A  -1  - 

1-e  z 


Washout  Filter 


Fig.  15.  Washout  Filter 


20  40 


time  (sec) 


Heading  Rate 
(deg/sec) 


Fig.  J 6.  Response 
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The  open  loop  snap  roll  control  strategy  had  shown  that  the  stern  plane  roust 
stay  at  +25°  from  approximately  2 sec  to  about  5 seconds.  We  therefore  demand 
the  following  approximate  behavior  from  the  filter  to  a step  input  (consider 
the  heading  rate  to  be  like  a delayed  step  input,  for  the  moment  - see  Fig. 14). 
Response  specifications  for  a first  order  filter  to  a unit  step 
Peak  at  2 sec 

Decay  to  e * = 0.37  fraction  at  7 sec 
Time  constant  = 6 sec 
Pole  = 0. 15 

Steady  State  Response  = 0.33  fraction 

The  transfer  function  must  therefore  be  of  the  form: 

Hfo  _ cs  + 0.05 

H(S)  ' s + 0.15 

cs 1 

s + 0. 15  3 

where  we  -.-st  determine  a suitable  value  for  c.  Consider  the  delayed  step 


response 


or  in  th-. 


__c„  + _i\  ~s 
• .15  3s ' 


. - “rain  vruld  be: 


r -0.l5(fc-l).  1.  . .. 

. . e + rj  ] u ( t - 1 ) 


Arte-  r above  equation  is  dee.ned  to  delivet  the  correct  activating 
signal  to  the  stern  plane  relay,  the  equation  was  encoded  into  z-domain,  ami 
incorporated  in  a difference  equation.  This  entire  operation  is  put  in  the 
program  as  a filter,  and  is  called  the  ’washout  filter’  [11. 


(0.1 5c-  0.05) 

r , -0.15A  -I 

l 1 - e z 


ALX(k+l) 


Y ( k+ 1 ) 


Q *AUX(k)+ 
-AUX(k)  + 


P * PS I DOT 
C * PS  I DOT 


where  * 


-0. 15A 


P - A (3. I5c  - 0.05) 

* NOTE:  A » I5CCN*D7  because  the  subroutine  AUTO  is  called  only  once  every  ISC0N 
integration  steps. 
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L L _ne  a r__S  ub  s vstem 

A leaky  integrator  is  incorporated  into  the  control  system  to  include  an 
accumulative  depth  error  correction  to  the  stern  plane.  Specifications 
for  the  integrator  are  shown  in  Fig. 17. 

The  difference  equation  introduced  in  subroutine  AUTO  [A]  is  given  below  [A], 
USA (k+1)  = Q * SA (k)  + P * ZERR(k+l) 


where 


Q = e 


-0.05A 


P = 0.009A 


= e. 

0.009 

5S  z 

4 e 

0.009A 

’ 

s + 0.05 

To 

1 - Q sf 1 

Sternplane 

' . c.  17.  Leaky  Integrator:  From 


Z^  to  Sternplane 


The  ' ranuever  is  generated  by  the  positive  bow  plane  relay  activated  by 

the  heactr.g  rate. 

The  . : -.-tic  control  (summation  of  corrective  manuevers  from  the  relay, 
Integra:  r.  c / - linear  control  sytem  initially  present  in  subroutine  AUTO) 
generates  : ie  ->ow  and  stern  plane  deflection  shown  in  Fig.  18  and  19  for 
! V and  -1  . . The  + 20  hard  rudder  runs  were  made  to  test  the  versatility 

f the  c n ’ 1 system.  The  roll  responses  for  +35"  and  +20  hard  rudder 

with  the  automatic  control  activated  are  compared  to  those  obtained  (a)  without 
any  stern  plane  or  low  plane  control  and  (b)  with  our  open-loop  control  strategy. 
These  are  shown  in  Fig.  20  and  21. 
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20  30  40 

time  (sec) 


_ Control  System 

- Control  Strategy 
No  Control 
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The  responses  of  our  control  system  to  +35°  rudder  deflection  and  +20° 
rudder  deflection  are  listed  in  Table  13a  and  13b  and  Table  14a  and  14b  respectively. 


TABLE  13a 


6 = +35° 

(Automatic  Control) 

TIME 

SPEED 

PITCH 

DEPTH 

ROLL 

HEADING 

(sec) 

(ft /sec) 

(deg) 

(ft) 

(deg) 

(deg) 

0 

8.7 

0 

0 

0 

0 

1 

8.1 

-0.4 

-0.3 

3.6 

-9.5 

2 

7.1 

-2.2 

-0.8 

3.7 

-26.8 

3 

6.1 

-4.5 

-1.1 

7.5 

-44.2 

4 

5.4 

-5.2 

-1. 1 

9.4 

-60.0 

5 

5.0 

-4.9 

-0.8 

5.2 

-74.3 

6 

4.7 

-5.0 

-0.5 

-3.4 

-87.4 

7 

4.5 

-5.8 

-0.1 

-11.8 

-99.5 

8 

4 . 4 

-6.9 

0.4 

-16.4 

-111.  JL 

3 . 4 

4.4 

-7.3 

0.7 

-16.8 

-115.7 

9 

4.3 

-7.9 

1.2 

-16.2 

-122.6 

10 

4.3 

-8.5 

2.1 

-14.3 

-134.1 

10.4 

4. 3 

-8.5 

2.5 

-13.9 

-138.8 

11 

4.3 

-8.4 

3.1 

-14.0 

-145.7 

12 

4 . 3 

-8.0 

4. 1 

-15.3 

-157.1 

13 

4.3 

-7.5 

5.1 

-16.  1 

-168.5 

14 

4.3 

-7.3 

6.1 

-15.7 

-179.9 

15 

4.3 

-7.1 

7.0 

-15.3 

-191.3 

20 

4.3 

-6.2 

11.3 

-15.6 

-248.5 

40 

4.3 

-3.2 

23.6 

-15.9 

-477.4 
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TABLE  13b 


<$r  - -35°  (Automatic  Control) 


TIME 

(sec) 

SPEED 
(f  t/sec) 

PITCH 

(deg) 

DEPTH 

(ft) 

ROLL 

(deg) 

0 

8.7 

0 

0 

0 

1 

8.0 

-0.  A 

-0.3 

-0.2 

2 

7.1 

-3.3 

-0.9 

3.2 

3 

6.1 

-7.  A 

-1.1 

-1.6 

A 

5.  A 

-9.5 

-0.6 

-7.5 

5 

5.0 

-9.5 

-0.2 

-6.5 

6 

A. 7 

-9.3 

1.1 

2.3 

7 

A. 5 

-9.7 

2.1 

1A.0 

8 

A.  A 

-10.8 

3.1 

21.2 

8.  A 

A.  A 

-11. A 

3.6 

21.7 

9 

A. 3 

-12.3 

A.  A 

20.2 

10 

A. 3 

-13.3 

5.8 

16.1 

10.6 

A. 3 

-13.5 

6.7 

1A.8 

11 

A.  3 

-13.5 

7.  A 

1A.9 

12 

A. 3 

-13.0 

9.1 

16.7 

13 

A.  3 

-12. A 

10.7 

17.8 

1A 

A. 3 

-12.0 

12.3 

17.  A 

15 

-.3 

-11.7 

13.8 

17.0 

20 

A. 3 

-10.5 

21.0 

17. A 

AO 

A. 3 

-7.0 

A3. 2 

17.5 

HEADING 

(deg) 

0 

9. A 
26.5 
A3. 5 
59.3 

73.7 
86.9 

99.2 

110.7 
115.3 
122.2 

133.8 
1A0.8 
1A5.5 

157.2 
168.7 

180.2 
189. A 

2A9.A 

A79.7 
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TABLE  14a 


r 


<5r  = +20° 

(Automat  1c 

Cont  rol) 

TIME 

SPEED 

PITCH 

DEPTH 

ROLL 

HEAD  INC 

(sec) 

(f  t/sec) 

(deg) 

(ft) 

(deg) 

(deg) 

0 

8.7 

0 

0 

0 

0 

1 

8.5 

-0.5 

0 

2.2 

5.7 

2 

7.9 

-3.3 

-0.2 

-0.7 

-17.5 

3 

7.2 

-8.2 

-0.2 

-0.3 

-30.6 

4 

6. 6 

-12.2 

0.5 

2.2 

-43.7 

5 

6.1 

-14.4 

1.8 

4.3 

-56.5 

6 

5.8 

-15.9 

3.5 

3.7 

-68.7 

6.8 

5.6 

-16.2 

5.0 

1.1 

-78.0 

7 

5.6 

-16.2 

5.4 

0 

-80.3 

8 

5.4 

-15.9 

7.4 

-7.3 

-91.2 

9 

5.4 

-15.3 

9.5 

-15.5 

-101.7 

10 

5.3 

-14.7 

11.6 

-18._8 

-111.8 

11 

5.3 

-13.9 

13.6 

-17.0 

-122.0 

12 

5.3 

-12.7 

15.6 

-14.8 

-132.0 

13 

5.3 

-10.9 

17.4 

-14.1 

-141.9 

14 

5.3 

-8.9 

19.0 

-14.2 

-151.6 

15 

5 . 4 

-7.1 

20.4 

-14.  3 

-161.2 

16 

5.4 

-5.4 

21.4 

-14.5 

-170.8 

17 

5.4 

-3.9 

22.2 

-14.7 

-180.4 

20 

5.4 

-0. 1 

23.0 

-15.3 

-209.7 

40 

5.4 

13.2 

-4.5 

-16.2 

-410.9 

t 


TABLE  14b 


5r  = -20°  (Automatic  Control) 


TIME 

(sec) 

SPEED 
( f t/sec) 

PITCH 

(deg) 

DEPTH 

(ft) 

ROLL 

(deg) 

HEADINC 

(deg) 

0 

8.7 

0 

0 

0 

0 

1 

8.5 

-0.6 

0 

1.3 

5.7 

2 

7.9 

-4.1 

-0.2 

7.3 

17.2 

3 

7.2 

-10.5 

0 

-6.5 

29.6 

4 

6.1 

-15.8 

1.1 

-1.8 

42.4 

5 

6.1 

-18.9 

3.0 

-2.2 

55.2 

6 

5.8 

-20.5 

5.3 

-2.4 

67.8 

7 

5.6 

-21.1 

7.9 

1.5 

79.7 

7.4 

5.5 

-21.2 

8.9 

4.3 

84.2 

8 

5.4 

-21.1 

10.6 

9.5 

90.9 

9 

5.3 

-20.8 

13.5 

18.4 

101.6 

10 

5.3 

-20.6 

16.3 

21.8 

112.1 

10.6 

5.3 

-20.4 

18.1 

20.9 

118.3 

11 

5.3 

-20.1 

19.3 

19.7 

122.5 

12 

5 . 3 

-19.1 

22.2 

17.1 

132.8 

1 1 
_L  ~J 

5. 3 

-17.3 

25.0 

16.2 

143.0 

14 

5 . 3 

-15.3 

27.5 

16.1 

152.9 

15 

3 • 

-13.3 

29.9 

16.1 

162.7 

16 

5 . 4 

-11.4 

31.9 

16.3 

172.4 

16.8 

5 . 4 

-10.1 

32.9 

16.5 

180.2 

20 

5.4 

-5.6 

37.4 

17.3 

211.6 

24.8 

5.4 

-0.1 

39.2 

17.9 

258.7 

40 

5.4 

10.3 

23.4 

18.9 

410.7 
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It  must  be  emphasized  that  the  implementation  of  the  new  strategy 

poses  some  uniquely  difficult  problems.  To  name  a few,  a)  it  cannot  be 

implemented  via  a linear  controller,  b)  it  must  come  into  play  selectively, 

i.e.,  only  when  relatively  hard  rudder  is  applied,  and  r''  the  duration 

of  the  activation  of  the  positive  relays  (see  Fig.12)  has  to  be  controlled 

in  correspondence  with  the  amplitude  of  the  hard  rudder.  As  can  be 

observed  from  Tables  14a  and  13a  (showing  maximum  rolls  of  -16*7°  and  -18.8° 

for  -35°  and  -20°  step  rudders,  respectively),  our  automatic  control 

system  needs  some  fine  tuning.  From  Fig.  20  and  21  it  is  seen  that 

the  stern  plane  component  6g  for  +35°  and  +20°  rudder  steps  are 

very  similar;  they  should  not  be,  and  the  duration  of  positive  stern 

plane  for  the  +20°  rudder  step  should  have  been  shorter  that  it  is 

Further  work  must  be  done  to  redesign  the  washout  filter  of  Fig. 15  so 

as  to  better  adjust  the  duration  of  positive  maxima  of  the  stern  plane 

component  5 . However,  it  is  felt  that  the  basic  configuration 

S3 

proposed  here  is  adequate  for  achieving  the  new  turn  control  strategy 
in  a feedback  node. 
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APPENDIX  A 


VEHICLE  PARAMETERS 
(Data  Cards  Inputted  to 
NCSC  Trajectory  Program) 
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. 18000E-050. 

-0.48400E-03 

05060  -0.5G100E-02-0.75460E-03-0.61000E-04-0.49GOOE-03-0.28940E-020. 

05070  -Q.750SOE-02-0. 1710 OE-O 3 +0.87 6 £26-02-0. 64307E+00-0.12077C+00 
050EO  + 0 . 2 35  00E  + 02 

05090  0.  +0.15S33E+00+0.45166E+00+0.81333E+00+0.12200E+01+0.1570CE+01 

0510  0 +0,1£550E+01+0.229£SE+01+0.24983£+01+0.2G650E+01+0.27316E+01+0.27500E+01 
05110  + 0, 27500  F. + 01  + 0. 2658 3 E + 01+0. 251 3 3E *01  + 0, 24200E  + 01  + 0.2226GE  + 01  + 0. 18933 3 + 01 
05120  + 0.13GS6E+01  + 0.mi6E*01  + 0.7  7 833E  + 00*0.44333E+000. 

05130  0,  +0. 15333 E + 00  + 0.451 6CE  + 00  + 0.813 33E  + 00  + 0. 12200 E + 01  + 0. 15700 E+ 01 

05140  +0. 18550 E+ 01+0. 2298 3E+ 01+0. 24983E+01+0. 26650E+01+0. 27316E+ 01+0. 27500E+ 01 
0'S  150  +0, 27500E  + 01  + 0. 26583E+0 1+ 0.25183E+ 01  + 0. 2 4200E  + 01  + 0.2226GE+ 01  + 0.189333  + 01 
051G0  +0, 13666 E+01+0 . 101 16E+ 01+0 . 7 7853E+ 00+0. 44333E+000. 

05170  -0,1 64 93E+02-0. 16222 E+02-0.15722E+02-0.15056E+02-0.14222E+ 02-0. 13369E+ 02 
05130  -0,125 5 5E+02-0.10S09E+ 02-0. 9222 5 E +01-0. 75558E+ 01-0. 60975E+01-0.49725E+01 
05190  +0, 852 23E+ 01+0. 1 0092E+Q 2+0 . 1075 ££+ 02+0. 11097E+02+0 . 11592E+02+0 . 12258E+ 02 
05200  +0.12925E+02+0.13258F.+07+0.13425E+02+0.13592E+02+0.13673E+02 
05210  +0,63676E+00+0.64938E+00+0,Ii22SOE+01-0.20017E+01+0.48508E+01-0.16514£+02 
05220  +0.13200E+01-0.33500E-01+0.83117E+01Q.  0.  -0.10000E+01 

05230  +0,2970 8 E- 01-0. 14298E+020,  0.  + 0 . 70270E-03-0 . 19979E-01 
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05250  -0.95000E-03+0.19500E-02-0.10000E-020.  + 0 .10000 E-0 2-0 . 10000E-02 

05260  0.  -0.40000E-03-0.10000E-03  + 0.25000E-Q3-0.1250(14c-02  + 0.10000E+01 

0527C  0.  -0. 10000E+ 01-0. 1 4 29SE+02+ 0. 83333 E-01+0.48258E+ 01-0.21 94 2 t+ 01 

05250  -2, 14575 £+02 

05290  -0. 90653 E+ 040.  0.  0.  +0 . 9068 3E+ 040  . 

05300  0.  -0. 833336-01+0. 2448 2E+ 03+0 . 15091 E+0S+ 0 . 15091E+050 . 

05310  0.  0.  +0.3016/E+02+0.15673E+02 

05320  U S F RPV RUDDER  STEP  1 DEG  ---  SPEED  IS  1.44 

05330  STC?7M=C40.0  CUTT=.2P  DT=0,109  I SC0f«!=  1 IPLOT=  0 INTOPT=  0 I PUNCH*  00 


03340 

IfIXSP  = 1 

SZCC  = 0.0090 

05350 

1 STOUT  =01 

05360 

INITI AIS 

8.66  00000 

OU0CO 

0000  00000 

coooo 

00000 

00000 

00000 

C5370 

STATE 

O.COO  1000. 

05380 

ICCR  IREC 

02  0 0 0 0 0 

0-1-1- 

l-l-l-l 

05390 

D3SS 

00.0  24.23 

020.0 
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054  50 

D3 
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DR 
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DS 
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0001,1 
00020 
00030 
0 0 0 1*  0 
00050 
00050 
00070 
0S0S0 
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00550 
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//ZU0174NE  JOB  ( , , , R033, 60, 30, 5 ) , 1 KA1JTZ ’ , CLASS'O, NOT  I F Y*ZU0 1 74 
//STEPZ  FXEC  FTG1CLC,UB5=,USF.OU.P0549.$DOBECK.LIMKIIB' 

//FORT . SYS  I N DO  * 

C 

C 

C 

c 

c 

c 

c 

c 

c 

IMPLICIT  REAL*- 8 (A-H,0-Z) 

REAL* 4 FIR, SEC, THR, FOR 
C 

0 I MEN'S  I ON  TEA(C),NSIL(15),R{501,6) 

DIMENSION  FOR (501, 2) 

D I MENS' ON  FIR(501,2),SEC(501),THR(501) 

COMMON  /QFSAV/PDD ( 1556) , I POO, NOUS 

COMMON  / PR I N2/CUTT, SZ ERR, Z POLE, SZC, DRC, SPHERR, PH POLE, DUM1, DUM2 
COMMON  / PR  I N4/CC , SAI’.RAT,  PS  I POL,  DTT,  S I MPS I 
COMMON  / PR  I <3/ I STOUT 
C 


COMMON  X(50),XD(30),TITLE(12), 

A D8(12),DS(12),DR(12),PR0P(12),0FF(12),CLIP(1C), 

E BLFG(2,20),SLFG(2,20),RLFG(2,20),PLFG(2,20), 

C ESI (t),ALFA(6),XT(6),TBLST(G),TBLSP(f.),VT(6),V0L(6), 

D E PA, EDS, PPS I D, OT, T I ME , STOPTM, PAD( 11), 

E NT, ICON(7),IREC(6), II, INVOPT, I CHK, I PAIK 5 ) ,NST 

COMMON/ PR  IN/ PR  I (501,12),PRINT(20),TLAB(12), JPLOT, I PLOT, I RNUM 
COMMON  /STO/NSTOP 
COMMON  /ILL/IFIXSP 
CALL  COEF I 0( I DUM, UPRPM) 

I RNUM  = 0 

1C  READ(5,20,END=110)TITLE 
20  FORMAT ( 12A6 ) 

WR I Tc ( 6, 30)T I TLE 
30  FORMAT ( 1H1 , 5X , 1 2 A6 ) 

P.EAD(  5 , 4 0 ) STOPTM, OUTT,  DT,  I SCON,  I PLOT,  I l.'TOPT,  I PUNCH 
NSTOP'STOPTM 
READ(5,41)IFIXSP,SZC 
RE AD ( 5 , 5 20 ) I STOUT 
520  FORMAT (EX, 12) 

41  FORMAT (OX, I2,9X,F10.5) 

40  FORMAT (7X,F6.2,5X,F6.2,3X,F6.2,7X, I3,7X,I2,8X,I2,8X,I2) 

UR  I TE( 6, 50)  STOPTM, OUTT, DT, I SCON, I PLOT, INTOPT, I PUNCH 
WRITE ( 6, 51 ) I F I XSP, SZC 
WRITE(6, 527)1  STOUT 

527  FORMAT( /, 3X , 'STANDARD  OUTPUT  OPTION  = ' , I 2 , 3X, ' O'STAN . OUT.’,/) 

51  FORMAT ( // , 6X, 1 I F I XSP  = ' , I 3, 3X, ' SZERR  CONSTANT  « * , E 10 . 2 ) 

50  FORMAT  (// 6X , 'STOP  TIME  = ' , F8 . 2, 5X,  ' PRI  NT  INTERVAL  *= ' , F 7 . 2 , 

A 5X,  ' INTEGRATION  STEP  ' ' , F 7 . 3 , / /CX , ' CON'T  ROL  INTERVAL  MULTIPLE 
B 13, 5X, 'PLOT  OPTION  = ' , I 2, 5X, ' I NTEGRAT I ON  OPTION  *',12, 

C 5X, ' I PUNCH  »' , I 2) 
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00570 
00580 
00590 
00000 
00610 
00020 
00650 
00640 
00650 
00G6C 
00670 
00553 
00600 
00730 
00710 
00721 
03750 
03740 
03753 
03  76  0 
00773 
03753 
00  75: 
03603 
00  SI'. 
00623 

A '■  * * 
J C a.  • v 

00S43 
0 0 S 5 r. 
00?  . ■ 
0077  C 
00t  ? 3 
80890 
0 3 7 3" 
0051 : 
0332  : 
0333: 

c o 5 ; : 
03550 
00963 
00970 
00950 
00900 
01003 
01010 


NOWS’*  1 

KPRINT=OUTT/OT*0.05 

KCOUNT  = -l 

ICHK»0 

RRR-35. 

DTT=10.0D0*DT 
PSlP0L*=nt'XP(-.15*DTT) 
SAMRAT  = 0.000 
SIMPSI -O.OfO 
CUM1*0.CP0 
CC»15. 

SZERR-0.0 
SPIIERR'0 . 0 

ZP0LE-1.0D0-0.01D0*r<T 
PHPOLE  = 1.0!’0-0.01*OT 
CALL  INCONOt IDUM,UPRPK) 
C 
C 

60  KCOUNT “KCOUNT ♦ 1 

TIME**FLO.U(KfOL:;T)*nT 

C 


NOWS*NO.i’S*  1 
I F ( NOWS  , EQ . 301 ) NCWS**1 

I F ( KCOUNT/ KPR I NT* KPR I NT . NE . KCOUNT ) GOTOlll 
CALL  C'JT'UT 
J= JPLOT 

TRUPD*  P7 I NT ( 9 ) 

SANG-PRINT(S) 

PLUN»PR I NT (5) 

SPED*PP.I  NT(  2) 

R( J, 1 ) *PK I NT ( 9) 

R( J,2 ) *PR I NT ( 4 ) 

R( J , 3 > * PR  I NT ( 5 ) 

R(J,4)=PP. I <J,2) 

R ( J , 5 > = I ( J,  3 ) 

R( J , 6 ) *PR I (J,fc) 

FRAT6-PRI (3,5) 

fir(j,1)-p;’int(i2) 

F«R(J,2)*PRIiJT<9) 

SEC(J)  *PRI  r.T(lO) 

THR(  J ) * PR  I •;  r ( 12 ) 

IF( I STOUT . EQ. 0 )GO  TO  524 
523  FORMAT ( //, 
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0 1 £ 1 0 
01820 
01850 
OlSi.0  c 
01850  C 
01860  C 
01870  C 
01880  C 
01890  C 
01900  C 
01910  C 
01920  C 
01950  C 
01940  C 
01950  C 
01960  C 
01970 
019  80 
01990  C 
02000  C 
02010 
02029  C 

02052 
0204  0 

02053  2' 
020 " 3 
02570  2 

p ■»  n p ■ 

025" 
02ic: 
0212:  2 
C 2 1 : 2 

0215*  C 
C22-: 
02::  • 2 
0216'  : 
921"  2 


SUBROUT  I HO  LINEF(X,S,RA,C,TII!E,DT) 

IMPLICIT  REAL* 6 (A-H,0-Z> 

COMMON  /ST0/NSTOP 

UNEP  COMPUTES  THE  VALUE  OF  A FUNCTION,  X,  AND  ITS  SLOPE,  S, 

AT  T=(T IME*PT)  FROM  A PEICEWISE  LINEAR  DESCRIPTION,  RA(2,40). 

RA ( 1 , * ) CONTAINS  THE  TIME-BREAK  POINTS. 

R A ( 2 , * ) CONTAINS  THE  FUNCTION  VALUE  AT  THE  TIME-BREAK  POINT. 
BEFORE  RETURNING  THE  FUNCTION  AND  SLOPE  ARE  DIVIDED  BY  C.  C. 

X IS  COMPUTED  VALUE  OF  VARIABLE  AT  TIME+DT 
S IS  COMPUTED  VALUE  OF  THE  SLOPE  AT  TIKE+DT 

RA  IS  ARRAY  CONTAINING  BREAKPOINTS  WHOSE  ORDINATES  ARE  IN  UNITS 
WHICH  MUST  BE  OIVIDFD  BY  C TO  GET  APPROPRIATE  UNITS  FOR  X.  IF 
UNITS  IN  RAF  2 , * ) ARE  DEGREES,  C SHOULD  BE  RADIAN.  IF  UNITS  IN 
RA ( 2 , » ) ARE  RPil,  C SHOULD  BE  UNITY  (CONE  IN  PROP1). 

DIMENSION  RA(2,1) 

T *T IHE*DT 


CC=1./C 

DO  1G  I »2 ,NSTOP 
IFd.LE.RAd,  I > > GO  TO  20 
CONTINUE 
I -NSTOP 

2 f>  | •] 

S'CC*  ( FAC  2,  n-RAU,  IMl))/UA(l,l  )-P.A(  1 , I Ml)  > 
X-CC*PAC2,  |:;l)  + S*(T-RAd,  I Mi)  ) 


RET  fl 

END 
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02220  SUBROUTINE  AUTO(X,XD) 

02250  C 

02240  IMPLICIT  REAl»8  (A-H,0-Z) 

02250  C 

02  260  COMMON  /PR  I N2/OUTT,  SZERR,  2 POLE , S7.C,  DP.C , SPIIERR,  PHPOLE , DUM1,  DUM2 

02270  COMMON  / PR  I N4/CC , SAMRAT, PS  I POL , DTT, S IMPS  I 

02280  COMMON  PAOD(72), 

02290  A DBC 1 2 ) , P3 C 12 ) , DRC 12 ) , PROPC 12 ) , OFF  C 12 ) , CL  I PC  10 ) , 

02500  B BLFG(2,20),SLFG(2,20),RLFG(2,20),PLFGC2,20), 

02310  C BRIC6),ALFA(6),XT(6),TBLST(6),TBLSP(G),VT(6),VOLC6), 

02320  0 EPA,EOS,DPSID,DT,TI  ME, STOPTM,  PADC 1 1 ) , 

02350  E NT, ICON (7), IRECC6), I 1, INVOPT, 1C UK, I PAP  C 5 ) , NST 

02340  C 
02350  C 

02360  DIMENSION  X(1),XD(1> 

02570  DIMENSION  AB ( 5 ) , BBC  5 ) , AS ( 5 ) , BS C 5 ) 

C2380  DATA  AS/- 1 . 5,- . 2 , 0 . , . 2 , 1 . 5/ , BS/- 2 8 . 0 , 0 . , 0 . , 0 . , 2 8 . / 

02550  DATA  AB/-2 . , - 1 . 75 , 0 . , 1 . 73 , 2 , / , BB/- 2 0 . , 0 . , 0 . , 0 . , 20 . / 

02400  DATA  CB1 , CB2/ . 2 , 3 . / , CS 1 , CS2/ . 1 , . 5/ 

02410  C 
0242"  C 
02433  C 
02440  : 

0245"  C ‘ TOM AT  I C FEEDBACK  CONTROLAFOR  BOW  PLANE,  STERN  PLANE, 

02460  RUDDER,  AND  RPM  TO  CONTROL  DEPTH,  PITCH,  OFFTRACK, 

02470  C AND  SPEED 

024  30 
« 2 1 r ' " 

G2533  , 

02510  ?' 

0231 

025  3 0 
025-0 
0235  : 

02  5 6* 

025*. 

025  :' 

0 23  1 
0250  3 

026  1 . 

026  2 0 
C2530 
02540 
02553 
026GC  23u 
0 2 f 7 0 

02689  1 0 THERR’DS  C 4 ) - X ( 8 ) 

02690  ZERR  = DP.C4)  - X(12) 

02700  ZPOLF-0 .950 

02710  IFCTIME.LE.1.0)SZERR=0.0 

02  720  SZERR  = ZPOLE*SZFRR*ZERP, 

02730  DSORD  - -DSC  7)  * TIIERR  + D S ( 8 ) * XDC8) 

02  74  0 DBORD=-PBC7)*ZERR*DBC8)*XDC12) 

02759  DS0RD3"SZC*SZERR 

02  760  I F ( I CON ( 1 ) . EQ.20)PS0P.0'0S0RD*DS0RD3 

02770  GO  TO  ( 20 , 30 , 50, 20, 30, 50, 20, 30 , 80, 20 , 30, 5C , 20 , 30, 5 0 , 20, 30  ) , I CONI 


I CONI « ! CON C 1 ) 

I F < ICO-  : :) . EQ. 20) I CONI’  I CON  ( 1 ) / 10 
X 3 5 = 0 . 

X16*0 , 

‘.'•TIME/C:  TT  + 1.1 
IFCirCN(l)  . NE . 20 )GO  TO  234 

SAMRAT  = , ; I POL ’SAMRAT*  XP( 9) * C 0 , 150D0*CC-0 . 05000) *DTT 
SIMPS  I *""*>.P<  91-SAMRAT 
SIMPS! * A SCSI MPSI ) 

X1S«REL‘\YCAS,BS,SIMPSI  ) 

AXD9»XD( 9 ) » 5 / . 29G 
AXD9>=:i  ‘ 5SCAXD9) 

XIS’RELA • C AS,BB,AXD9) 

X16»X 16/37. 296 
X15-X15/57.296 
CONTINUE 

GO  TO  Cll  , 10, 50, 10, 10, 50, 10, 10,80, 10,10, 50,10,1 0,50, 10, 10), ICON! 
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02780  20  DSORD  = DSCRD  - DCORO 

0 2 790  GO  TO  1*0 

02S00  50  CONTINUE 

02810  DOBDOT=(DBORO-X(1S) )*DR(9) 

02S20  IF  (0 ABS( DDBDOT ).GT.DB(2))  DOBDOT  =05 I GN ( DB ( 2 ) , DDBDOT ) 

02850  XD ( 1 5 ) =OOBDOT 

02840  X(15)=X(15)+DT*ODBDOT 

02850  C 

02860  X(15)'X(15)+X15 

0287 0 IF(DABS(X(15)).GT.DB(5))X(15)=DSIGN(PB(3),X(15) ) 

02880  C 

02890  40  DDSDOT  = (OSORD  - X(16)  ) * DS(9) 

02900  IF  (DA3S(DPSP0T).GT.DS(2))  DDSDOT  =DS  I GN(DS(  2 ) , DDSDOT) 

02510  XD ( 1 6 ) =DDSDOT 

07920  XL16=DT*DDSDOT 

02950  C 

02950  DRC-Xlb »57 .296 

02960  X ( 16 ) =XL1 6+X16 

02970  I F ( 0ABS( X ( 16) ) . GT.OS(5))X(16) =DS IGN(DS(3),X(16)) 

02980  C 

02990  GO  TO  (90,90,50,50,50,50,50,50,80,80,80,50,050,050,50,050,050,100 

03000  A- -l 

03010  30  PSIERR  = Dk(4)  - XC9) 

03020  DRORD  = -DP.C/)  • PSIERR  + PR  ( 8 > * XD(9) 

03050  ONE  = 4 . 

03040  GO  TO (90, 90, 70, 70, 70, 60, 6 0,60, 80, 80, 8 0,70, 70,70,64,060,060), ICON) 

r;  osgre  -:ff(7)«(off(4)-x(h))  ♦ off(8)*xd(id 

03060  70  DC ROOT  * (DRORD  - X(18)  ) * DR(9) 

0 3 3 7 C IF  (DA3S(DL'PD0T)  .GT.DRC2)  ) DDRDOT  =DS  I GH(  DR(  2 ) , DDRDOT) 

05039  XD( 18 ) »rr ROOT 

03392  X(18)=X(15)»rT*DDRDOT 

03100  IF(DA5S(X(1?)).GT,DR(5))X(18)=DSIGN(DR(3),X(18>) 

03110  I F ( I CON( 1 ) . LT . 9 )GO  TO  90 

C312C  30  XR(  19)  = ( P R 0 P ( 4 ) - X ( 1 ) / 1 . 689 ) * PP.OP(  7 ) 

05150  X(19)*X'13)*DT*XD(19) 

03140  30  RETURN 
03150  END 
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